#ifndef __SERIALDEBUG_HPP
#define __SERIALDEBUG_HPP
#include <Wire.h>
#include<Arduino.h>
#include<stdio.h>
typedef unsigned int u32t;


void scanIIC();//扫描I2C地址
void DIRIIC(char dirv[]);//指令调试I2C,支持向目标元件的寄存器读写数据



/****************2021 AKARIN********************/
/********        I2C调试函数库   NOV.12         */
/**********************************************/

void scanIIC()
{
  Serial.println("\nI2C Scanner");
  byte error, address;
  int nDevices;
  Serial.println("Scanning...");
  nDevices = 0;
  for (address = 1; address < 255; address++ ){
    // The i2c_scanner uses the return value of
    // the Write.endTransmisstion to see if
    // a device did acknowledge to the address.
    Wire.beginTransmission(address);
    error = Wire.endTransmission();
    if (error == 0){
      Serial.print("I2C device found at address ");
      if (address < 16)
        Serial.print("0");
      Serial.print(address, DEC);
      Serial.println(" !");
      nDevices++;
    }else if (error == 4){
      Serial.print("Unknow error at address ");
      if (address < 10)
        Serial.print("0");
      Serial.println(address, DEC);
    }
  }
  if (nDevices == 0)
    Serial.println("No I2C devices found\n");
  else
    Serial.println("done\n");
  }

void DIRIIC(char dirv[])//指令调试I2C,支持向目标元件的寄存器读写数据
{
  if(dirv[0]=='W' && dirv[1]=='R' && dirv[2]=='I')//向目标地址写入数据:指令格式:WRI DDD(ADR) DDD(REG) DDD(DAT)格式均为10进制
  {
    byte slaveADDR=(dirv[4]-0x30)*100+(dirv[5]-0x30)*10+(dirv[6]-0x30);
    byte slaveREG=(dirv[8]-0x30)*100+(dirv[9]-0x30)*10+(dirv[10]-0x30);
    byte slaveOPC=(dirv[12]-0x30)*100+(dirv[13]-0x30)*10+(dirv[14]-0x30);
    Wire.beginTransmission(slaveADDR|0x80);
    Wire.write(slaveREG);
    Wire.write(slaveOPC);
    Wire.endTransmission();  
    Serial.println("DONE");
    }
  if(dirv[0]=='S' && dirv[1]=='C' && dirv[2]=='A')//向目标元器件扫描内存情况:指令格式:SCA DDD
  {
    byte slaveADDR=(dirv[4]-0x30)*100+(dirv[5]-0x30)*10+(dirv[6]-0x30);
    byte RECDAT[255]={};
      for(int i=0;i<255;i++)
      {
        Wire.beginTransmission(slaveADDR);
        Wire.write(i);
        Wire.endTransmission();
        RECDAT[i]=Wire.requestFrom(slaveADDR,1); 
        RECDAT[i]=Wire.read();
      }
      Serial.println("00 01 02 03 04 05 06 07 08 09 0A 0B 0C 0D 0E 0F");
      Serial.println(' ');
      for(int i=0;i<255;i++)
      {
        if(byte(RECDAT[i])<15)
      {
        Serial.print("0");
        Serial.print(byte(RECDAT[i]),HEX);
      }
      else
        Serial.print(byte(RECDAT[i]),HEX);
      if((i+1)%16==0)//如果一行满16个数据，则进入下一行
        Serial.print('\n');
      else
        Serial.print(' ');
      }
      Serial.println(' ');
   }
   for(int i=0;i<30;i++)
   dirv={};//使参数清零

}
static void DebugIIC()
{
  byte addr;//转换后的地址
  byte subaddr;
  char rec[20]={};
  int i=0;
  byte IICRECV;
  char SUBMEM[255]={};
    Serial.println("PLEASE INPUT IIC ADDRESS");
    while(Serial.available()==0);//当串口没有数据的时候等待数据接收
    while(Serial.available()>0)
    { 
     delay(20);//等待串口数据完整进入缓存区域
     rec[i]=Serial.read();
     i++;
      }
      
    addr=(rec[0]-0x30)*100+(rec[1]-0x30)*10+(rec[2]-0x30);
    for(subaddr=0;subaddr<255;subaddr++)//扫描255个子地址
    {
      Wire.beginTransmission(byte(addr));
      Wire.write((byte)subaddr);
      Wire.endTransmission();  
      IICRECV=Wire.requestFrom(addr,1);
      IICRECV=Wire.read();
      SUBMEM[subaddr]=IICRECV;
    }
    Serial.println("00 01 02 03 04 05 06 07 08 09 0A 0B 0C 0D 0E 0F");
    Serial.println(' ');
    for(int i=0;i<255;i++)
    {
      if(byte(SUBMEM[i])<15)
      {
        Serial.print("0");
        Serial.print(byte(SUBMEM[i]),HEX);
      }
      else
      Serial.print(byte(SUBMEM[i]),HEX);
      if((i+1)%16==0)//如果一行满16个数据，则进入下一行
      Serial.print('\n');
      else
      Serial.print(' ');
      }
      Serial.println(' ');
  }

int fputc(int ch,FILE* f)//若需要使用printf,putchar函数，则需要写一个fputc函数
{
  Serial.print(ch);//发送数据ch，从USART1口输出
  return ch;
}

int fgetc(FILE* c)//若要使用getchar,scanf函数，则需要这个fgetc函数
{
  while(Serial.available()==0);//当串口没有数据时，无限等待
  return(Serial.read());
}

#endif
